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(57) Abstract 



The present invention provides an apparatus (100) for controllably moving a vehicle's work implement (102). The work implement 
(102) includes a first appendage (104) pivotally connected to the vehicle, and a second appendage (106) pivotally connected to the first 
appendage (104). The apparatus (100) senses the geometry of the work implement (102) and responsibly producing a plurality of position 
signals and produces one of a manual control mode signal and an automatic control mode signal. An operator interface (128) produces 
first and second lever command signals indicative of desired movement of the work implement (102). The apparatus (100) receives the one 
control mode signal and the first and second lever control signals and responsively produces linear motion of the end point of the second 
appendage (106) along first and second work axes if the one control mode signal is equal to the automatic control mode signal. 
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Description 

Coordinated Control for a Work Implement 

5 Technical Field 

This invention relates generally to a control 
system for controlling a work implement on a work 
vehicle, and more particularly to a control system 
which provides a coordinated control interface between 
10 the work implement and the vehicle operator. 

Background Art 

In the field of work vehicles, particularly 
those vehicles which perform digging or loading 

15 functions such as excavators, backhoe loaders, and 

front shovels, a work implement is generally controlled 
by a manual control system having two or more operator 
control levers, and additionally, other vehicle control 
devices. Typically, the manual control system often 

20 includes foot pedals as well as hand operated levers. 

A backhoe manufactured by J. I. Case Manufacturing Co., 
for example, employs three levers and two pedals to 
control the work implement. A backhoe manufactured by 
Ford Motor Co. utilizes four control levers. There are 

25 drawbacks associated with these implement control 

schemes. One is operator stress and fatigue resulting 
from having to manipulate so many levers and pedals. 
Further, a vehicle operator is required to possess a 
relatively high degree of expertise to manipulate and 

30 coordinate the control levers and foot pedals 

proficiently. To become productive, an inexperienced 
operator also requires a long training period to be 
familiar with the controls and their functions. 
Some manufacturers recognize the 

35 disadvantages of having too many controls, and have 
adopted a two-lever control scheme as the norm. 
Generally, two vertically mounted two-axis levers share 
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the task of controlling the movement of the work 
implement's appendages (boom and stick) and the bucket 
of the work implement. For example, hydraulic 
excavators presently manufactured by Caterpillar Inc. 
5 employ one joystick for stick and swing control, and 
another joystick for boom and bucket control. 
Similarly, Deere & Co. has a hydraulic excavator with a 
joystick for boom and swing control, and another for 
stick and bucket control. In each instance, the number 

10 of controls has decreased to two, making machine 

operation much more manageable. However, these two- 
lever control schemes are still not wholly desirable. 
The assignment of implement linkages to the joysticks 
is entirely arbitrary, and there exists little 

15 correlation between the direction of movement of the 
work implement linkages and those of the control 
levers . 

Further, in a typical leveling operation (or 
slope finish) the operator has to manipulate the 

20 control levers about or along at least three axes to 
produce a linear movement of the bucket. The 
complexity and skill involved increase when performing 
these types of operations, thereby increasing operator 
fatigue and required training time. 

25 The present invention is directed to 

overcoming the problems set forth above. 

Disclosure of the Invention 

In one aspect of the present invention, an 
3 0 apparatus for controllably moving a vehicle's work 

implement is provided. The work implement includes a 
first appendage pivotally connected to the vehicle, and 
a second appendage pivotally connected to the first 
appendage. The apparatus senses the geometry of the 
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work implement and responsibly produces a plurality of 
position signals and produces one of a manual control 
mode signal and an automatic control mode signal • An 
operator interface produces first and second lever 
5 command signals indicative of desired movement of the 

work implement. The apparatus receives the one control 
mode signal and the first and second lever control 
signals and responsively produces linear motion of the 
end point of the second appendage along first and 

10 second work axes if the one control mode signal is 
equal to the automatic control mode signal. 

In another aspect of the present invention, 
a method for controllably moving a vehicle's work 
implement is provided. The implement includes a first 

15 appendage pivotally connected to the vehicle and a 
second appendage pivotally connected to the first 
appendage. The method includes the steps of sensing 
the geometry of the implement, sensing movement of a 
plurality of control levers, and producing a control 

20 signal in response to receiving one of a manual control 
mode signal and an automatic control mode signal. The 
method further includes the step of responsively 
producing linear motion of the second end point of the 
second appendage along first and second work axes in 

25 the automatic control mode. 

Brief Description of the Drawing 

Fig. 1 is a diagrammatic view of the 
coordinated control system and the work implement; 
30 Fig. 2 is a diagrammatic view of the work 

implement illustrating pertinent points on the work 
implement; 

Fig. 3 is an isometric view of the control 
levers mounted with respect to an operator seat; 
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Fig. 4 is a side view of the vehicle 
performing bucket level motion with phantom lines 
illustrating implement movement; 

Fig. 5 is a side view of the vehicle 
5 performing slope finish motion with phantom lines 
illustrating implement movement; 

Fig. 6 is a block diagram of the coordinated 
control implementation; 

Fig. 7 is a flow diagram illustrating the 
10 operation of the control implementation; and 

Fig. 8 is a flow diagram illustrating the 
operation of the control implementation according to a 
preferred embodiment of the present invention. 

15 Best Mode for Ca rrying Out the Invention 

With reference to Fig. 1, the present 
invention 100, hereafter referred to as a coordinated 
control system, is adapted to controllably provide 
linear movement of a work vehicle's work implement 102. 

20 The work implement 102 typically includes a first 
appendage 104, a second appendage 106, and a third 
appendage 108. For discussion purposes, the work 
vehicle is a hydraulic excavator, but the instant 
control system 100 is also suitable for application on 

25 other vehicles such as backhoe loaders, front shovels, 
wheel loaders, track loaders, and skidders. 

In the preferred embodiment, the appendages 
(or linkages) correspond to the boom 104, stick 106, 
and bucket 108 of the hydraulic excavator, as shown. 

30 However, the implement configuration can differ from 

machine to machine, and the configuration may include a 
working device other than a bucket, such as a clam 
shell or grapple. In certain machines, such as the 
excavator, the operator cab together with the work 
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implement is rotatable along a vehicle center axis; in 
others, such as a the backhoe loader, the operator cab 
is stationary and the work implement is swingable to a 
different site at the pivot at the base of the boom. 
5 This difference is not significant and the 

implementation of the coordinated control system 100 in 
the two cases will be substantially identical. 

The work implement 102 of the work vehicle is 
generally actuated in a vertical plane 110, and 

10 swingable, with the operator cab, to a plurality of 
second planes different from the first plane by 
rotating the vehicle platform or swinging at the pivot 
base of the boom. The boom 104 is actuated by a first 
hydraulic actuating means 111 having two hydraulic 

15 cylinders 112,114 enabling raising and lowering of the 
work implement 102. The stick 106 is drawn toward and 
away from the vehicle by a second hydraulic actuating 
means 115. The second actuating means 115 includes a 
hydraulic cylinder 116. A third hydraulic actuating 

20 means 117 includes another hydraulic cylinder 118. The 
third actuating means 117 "opens" and "closes" the 
bucket (referred to as the curling function) . The 
hydraulic flow to the hydraulic cylinders 
112,114,116,118 are regulated by hydraulic control 

25 valves 120,122,124,126. 

An operator interface means 128 provides 
operator input to the coordinated control system 100. 
The operator interface means 128 includes a first 
control lever 130 and a second control lever 132. 

30 In one embodiment, the control levers 130,132 

are electronic (inductive) control levers (or 
joysticks) . One suitable joystick is available from 
CTI Electronics of Bridgeport, CT, USA, but other 
types may also be used. The output of the electronic 
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joysticks are electrical signals indicative of the 
relative movement along or about predefined axes. 

In another embodiment, the control levers 
130,132 are mechanical joysticks. The control levers 
5 actuate pilot systems (not shown) of the vehicle's 
hydraulic system. In the manual modes, the pilot 
systems actuate control valves for each of the 
respective cylinders. In the automatic or semi- 
automatic modes, the pilot systems are circumvented by 
10 the electronic controls. However, the pilot systems 
include pressure sensors for producing signals 
indicative of the control levers 13 0,132 relative 
movement . 

In one embodiment, the first control lever 

15 130 has three degrees of movement, all in one plane 134 
substantially parallel to work implement plane 110: 
towards the front and rear of the vehicle (along a 
first control axis 136) , vertically up and down (along 
a second control axis 138) , and rotationally , shown by 

20 arrow 140 (about a third control axis 142) . The second 
control lever 132 is movable to the left and right of 
the vehicle (along a fourth control axis 143) . 

In another embodiment, the first control 
lever 130 has two degrees of movement: along the first 

25 control axis 136 and along the second control axis 138. 
The second control lever 132 also has two degrees of 
movement: along the fourth control axis 143 and towards 
the front and the rear of the vehicle (along a fifth 
control axis 145) . 

3 0 The first control lever 13 0 generates one 

signal for each respective degree of movement, each 
signal representing the control lever displacement 
direction and velocity from neutral. Similarly, the 
second control lever 132 generates a signal for the 
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left-right displacement direction and velocity for 
implement side swing control. 

A means 144 produces an electrical signal 
indicative of a desired slope angle (discussed below) . 
5 In one embodiment, the means 144 includes a thumb wheel 
switch 14 6 having three indicators 148,150,152. The 
first indicator 148 is movable between a positive 
position (indicative of a positive desired slope angle) 
and a negative position (indicative of a negative 

10 desired slope angle) . The second and third indicators 
150,152 are each movable between ten positions (0-9) 
representing the magnitude of the desired slope angle 
(between zero and ninety degrees) . In an other 
embodiment, the means 144 includes a LED display and a 

15 series of buttons for displaying and inputting the 
desired slope angle. 

In the preferred embodiment, the means 144 
also includes means for generating an other electrical 
signal indicative of a desired bucket angle. The means 

20 144 also includes means for generating a desired mode 
signal. 

The electric signals are received by a logic 
means 154 , which in response delivers to the hydraulic 
control valves 120,122,124,126 a plurality of work 

25 implement control signals. 

Referring to Fig. 2, a simplified view of the 
work implement 102 is shown, defining a number of 
points and axes used by the logic means 154. The work 
implement 102 is pivotally mounted on a portion of the 

30 excavator's cab 156 at pivot point b. An axis, X bm , 

is defined, having an origin at point b and a constant 
direction with respect to the cab 156. Axis X bm is 
used to measure the relative angular relationship 
between work vehicle 156 and the boom 104. Point a is 
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defined as a point on axis X bm - The boom hydraulic 
cylinders 112,114 (for simplicity only one is shown) is 
connected between the work vehicle 156 and the boom 104 
at points 1 and c, respectively. 
5 The stick 106 is pivotally connected to the 

boom 104 at point e. The stick hydraulic cylinder 116 
is connected between the boom 104 and the stick 106 at 
points d and f , respectively. An axis, X stk , is 
defined, having an origin at point e and a direction 

10 constant with respect to the boom 104. Axis X gtk is 
used to measure the relative angular relationship 
between the boom 104 and the stick 106. Point n is 
defined as a point on axis X gtJc . 

The bucket 108 is pivotally connected to the 

15 stick 106 at point i. An axis X bkt is defined, having 
an origin at point i and a constant direction with 
respect to the stick 106. Point o is defined as a 
point on X bkt . The bucket hydraulic cylinder 118 is 
connected to the stick 106 at point g and to a linkage 

20 158 at point j. The linkage 158 is connected to the 
stick 106 and the bucket 108 at points h and j, 
respectively. A point m is defined at the tip of the 
bucket 108. 

Referring now to Fig. 3, an isometric view of 
25 the operator seating area and manual controls is shown. 
The operator, when seated in an operator seat 302, can 
rest his or her arms on arm rests 304,306 where the 
control levers 130,132 are within easy reach. In one 
embodiment, the first control lever 130 is mounted 
30 substantially horizontal and the second control lever 
132 is mounted substantially vertical, as shown. In 
another embodiment, both control levers 130,132 are 
mounted substantially vertical. 
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In one embodiment of the instant invention, 
the control system 100 has six modes of operation: 

A. manual control mode, 

B. manual control mode with bucket attitude 
5 control, 

C. linear control mode, 

D. linear with constant bucket attitude control 
mode, 

E. slope finish control mode, and 

10 F. slope finish with constant bucket attitude 

control mode. 
Each mode is explained in depth below. 

In the manual control mode, the control 
levers 130,132 control movement of the work implement 

15 appendages (boom, stick, bucket) 104,106,108 

independently, that is, movement of the first control 
lever 130 along a specific control axis 136,138,142 
corresponds to a specific linkage on the implement. 

In one embodiment, movement of the first 

20 control lever 130 in directions along the first control 
axis 136 controls the flow of hydraulic fluid to the 
stick hydraulic cylinder 116 and movement of the first 
control lever 13 0 in directions along the second 
control axis 138 controls the flow of fluid to the boom 

25 hydraulic cylinders 112,114. Further, rotational 

movement of the first control lever 13 0 about the third 
control axis 142 controls the curling motion of the 
bucket 108 and movement of the second control lever 132 
along the fourth control axis 143 controls the swing 

3 0 motion of the excavator cab. 

In another embodiment, movement of the 
horizontal control lever 13 0 in directions along the 
first control axis 13 6 controls the flow of hydraulic 
fluid to the boom hydraulic cylinders 112,114 and 
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movement of the horizontal control lever 130 in 
directions along the second control axis 138 controls 
the curling motion of the bucket 108 • Further, 
movement of the second control lever 132 along the 
5 fourth control axis 143 controls the swing motion of 

the excavator cab and along the fifth control axis 145 
controls the flow of hydraulic fluid to the stick 
hydraulic cylinder 116. 

In the manual with bucket attitude control 

10 mode, the operator retains manual control of the boom 
and stick hydraulic circuits. However, the bucket 
circuit is controlled automatically to adjust the 
bucket to retain a constant bucket angle with respect 
to a horizontal plane. Actuation of one of the control 

15 levers 130,132, as discussed above, may be used to 
adjust the bucket angle during operation. 

In the four remaining automatic or semi- 
automatic control modes, the control of the appendage 
movements are simultaneously coordinated to provide 

20 linear movement. With reference to Figs. 4 and 5, the 
work implement 102 of a work vehicle 302 has a 
substantially linear bucket motion with respect to the 
vehicle 3 04. 

In all four coordinated modes, the direction 

25 and velocity of the linear motion is prescribed by the 
movement of one control lever 130,132 along one control 
axis 136,138,143,145. 

In one embodiment of the linear control mode, 
movement of the control levers 130,132 along or about 

30 the control axes 13 6,138,142,143 provide the following 
functions: 

first control axis 13 6 linear horizontal 

movement of point i 
second control axis 13 8 linear vertical 
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movement of point i 
third control axis 142 curling function of 

the bucket, and 
fourth control axis 14 3 swing control. 

5 With reference to Fig. 4, movement of the first control 
lever 13 0 along the first control axis 13 6 provides a 
linear horizontal movement of point i. The linear 
motion of point i is accomplished by automatically 
coordinating the flow of hydraulic fluid to the boom 
10 and stick cylinders 112,114,116 (discussed below). 

Manual control over the curling and swing functions 
remain the same as in the manual control mode. 

In another embodiment of the linear control 
mode, the control levers 130,132 are each moveable 
15 along two control axes 136,138,143,145. Movement along 
each control axis 136,138,143,145 corresponds to one of 
the control functions, as described above. 

In still another embodiment, the angular 
relationship between the bucket and the stick remains 
20 constant and linear motion of point m is provided. In 
other words, the bucket 108 is treated as an extension 
of the stick 106. 

The linear with constant bucket attitude mode 
is similar to the linear control mode, except that 
25 manual control over the curling function is eliminated. 

Linear motion of point i is provided in the same manner 
as described above. In addition the actuation of the 
bucket hydraulic cylinder 118 is coordinated such that 
a constant bucket angle with respect to the vehicle 302 
30 is maintained. Therefore, in drawing the bucket level 
toward the vehicle, all three linkages require 
simultaneous and coordinated control. 

In accordance with the control modes 
described above, the present invention provides a 
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system 100 which actuates the vehicle hydraulics 
according to the control modes. The control system 100 
includes a means 603 for sensing the geometry of the 
work implement 102 and responsibly producing a 
5 plurality of position signals. 

The means 14 4 produces one of a manual 
control mode signal and an automatic control mode 
signal. In the preferred embodiment, there are two 
manual modes and four automatic modes: manual control 
10 mode, manual with bucket attitude control mode, linear 
control mode, linear with bucket attitude control mode, 
slope finish control mode, and slope finish with bucket 
attitude control mode. 

The operator interface means 128 produces 
15 first and second lever command signals indicative of 
desired movement of the work implement 102. 

The logic means 154 for receives the one 
control mode signal and the first and second lever 
control signals, responsively produces linear motion of 
20 the second end point of the second appendage 106 along 
first and second work axes 404 , 412 , 4 04 ' , 412 ' if the one 
control mode signal is equal to the automatic control 
mode signal, and responsively produces angular motion 
of the first and second appendages 104,106 in 
25 proportion to the first and second lever command 

signals, respectively, if the one control signal is 
equal to the manual control mode signal. 
The logic means includes: 
1. a means for receiving the position signals and 
30 for responsibly calculating a plurality of mode value 
signals (r ) . The mode value signals are in terms of 
angular velocities of the appendages if the one control 
mode signal is equal to the automatic control mode 
signal; 
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2. a means for responsibly calculating a plurality 
angular-to-linear value signals (s q ) . The angular-to- 
linear value signals are in terms of linear 
velocity/ angular velocity if the one control mode 

5 signal is equal to the automatic control mode signal; 
and 

3 . a means for calculating a plurality of 
transformation signals (t) as a function of the 
angular-to-linear value and mode value signals; and for 

10 calculating a plurality of cylinder velocity command 

signals as a function of the mode value signals and the 
angular-to-linear value signals. 

The actuating means 109 receives cylinder 
velocity command signals and responsibly actuates the 

15 work implement 102. 

Fig. 4 specifically illustrates linear motion 
of the work implement along a first work axis (X) 404. 
The first work axis 404 is substantially parallel to 
the plane of the vehicle 402. In the first phantom 

20 outline 406, the stick is out and the bucket is in a 
closed position. As the first control lever 130 is 
pulled towards the rear of the vehicle along the first 
control axis 13 6, the work implement 102 is drawn to 
the position shown by the second phantom outline 408, 

25 the boom is raised, stick closer to the vehicle, and 
the bucket in a more open position. At the final 
position shown by the solid outline 410, the boom is 
lowered, the stick is drawn in, and the bucket is open. 

Linear vertical movement along a second work 

30 axis 412 is performed in response to movement of the 
first control lever 13 0 along the second control axis 
138 in a similar manner. The second work axis (Y) 412, 
shown at the second phantom outline 408, is 
perpendicular to the first work axis 404. 



WO 94/26988 



- 14 - 



PCT/US94/02646 



Fig. 5 specifically illustrates linear motion 
of the work implement along a first work axis (X') 
404'. The first work axis 404' has an angular 
relationship with the vehicle 402. The slope angle is 
5 defined by the means 144. In the first phantom outline 
406', the stick is out and the bucket is in a closed 
position. As the first control lever 130 is pulled 
towards the rear of the vehicle along the first control 
axis 136, the work implement 102 is drawn to the 

10 position shown by the second phantom outline 308', the 
boom is raised, stick closer to the vehicle, and the 
bucket in a more open position. At the final position 
shown by the solid outline 410', the boom is lowered, 
the stick is drawn in, and the bucket is open. 

15 Linear vertical movement along a second work 

axis (Y') 412 ' is performed in response to movement of 
the first control lever 13 0 along the second control 
axis 138 in a similar manner. The second work axis 
412', shown at the second phantom outline 408', is 

20 perpendicular to the first work axis 404'. 

In a vehicle with conventional controls where 
each linkage is controlled independently, all the 
linkage motions are explicitly controlled and 
manipulated by the operator. Since the primary concern 

25 of the vehicle operator is the placement of the bucket, 
all four coordinated control modes of the instant 
invention allows exact operator displacement and 
directional control of the bucket regardless of the 
geometry of the work implement. Therefore, to perform 

30 bucket level motion such as in floor finishing, the 
operator needs only move the first control lever 13 0 
towards the front or rear of the vehicle. 

In the preferred embodiment, the logic means 
154 is implemented on a microcontroller. Typically, 
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the microcontroller is microprocessor based. One 
suitable microprocessor is available from Motorola Inc. 
of Roselle, IL as part no. MC68332, but any suitable 
microprocessor is applicable. 
5 Referring now to Fig. 6, a block diagram of 

the coordinated control as implemented on the logic 
means 154 in software is shown. The electric signals 
which are generated by the control levers 13 0,132 are 
shown as joystick velocity request inputs to the block 

10 diagram. These velocity request signals are in 

Cartesian coordinates corresponding to the control 
lever movement. The velocity requests are transformed 
at block 602 to a different coordinate system based on 
the configuration and position of the linkages. 

15 A means 603 senses the geometry of the work 

implement 102 and responsibly produces a plurality of 
position signals. In one embodiment, the linkage 
position sensors include linkage angle resolvers for 
measuring the relative angles between linkages. In an 

20 other embodiment, the linkage position sensors include 
linear sensors for sensing the length or extensions of 
individual cylinders. Examples may be found in Robot 
Manipulators: Mathematics, Programming and Control by 
Richard P. Paul, MIT Press, 1981. 

25 The position signals are received by the 

velocity transformation. 

The upper portion of the coordinated control 
implementation of Fig. 6 (blocks 602,604,606,608) 
provides for manual control of the flow of hydraulic 

30 fluid to the hydraulic cylinders 112,114,116,118 

through the use of the control levers 13 0. The cylinder 
velocity requests (or joint angular velocity) from this 
translation process are scaled at block 604 by a factor 
obtained in the proportional flow control block 606. 
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Proportional hydraulic flow control is discussed in 
U.S. Patent No 4,712,376 issued to Hadank and Creger on 
Dec. 15, 1987. The basic concept of the proportional 
flow control involves calculating the amount of 
5 hydraulic flow available for implement actuation under 
current operating conditions (that is, engine speed, 
vehicle travel, etc.) The resultant scaled velocity 
request from block 604 is passed on to velocity control 
block 608 where an open or closed loop control 

10 determines the hydraulic valve velocity control signals 
to satisfy the cylinder velocity request. Such open or 
closed loop control systems are well known in the field 
of control theory and are therefore not discussed 
further. The hydraulic control valve signals are 

15 complemented with another set of signals to eliminate 
errors introduced in the Cartesian to linkage 
coordinate transformation. 

Referring now to block 610, the joystick 
velocity requests are scaled with the same factor 

20 obtained in proportional flow control. The scaled 

joystick velocity commands are integrated over time to 
obtain position commands 612 and transformed to the 
linkage coordinates 614. This transformation is 
similar to that of the transformation process in block 

25 602. The output of position transformation block 614 
is then passed on to another open or closed loop 
control 616 where hydraulic valve position control 
signal is determined. A suitable closed loop control 
using position and velocity control is disclosed in 

3 0 U.S. patent application 07/540,726, filed on June 15, 
1990 and commonly assigned. 

The hydraulic valve control signals from both 
branches are combined at an adder 618 to arrive at the 
final cylinder valve control signals for the work 
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implement. In the manual mode the lower portion of the 
control implementation is non-operable; the cylinder 
valve control signals are directly related to the 
velocity requests from the control levers (joysticks) 
5 130,132. 

While running in one of the coordinated 
control modes, the lower portion (blocks 610-616) of 
the control implementation are effective and part of 
the upper portion may also be operable. For example, 

10 in the linear with bucket attitude control mode, the 

lower portion of the control implementation coordinates 
the flow of fluid to the hydraulic cylinders 
112,114,116,118 in accordance with the horizontal and 
vertical velocity requests. The swing motion of the 

15 work implement 102 remains under manual control through 
blocks 602-608. Further, a bucket velocity request 
may be accepted by the control implementation from one 
of the control levers 130,132. This signal would be 
modified (as discussed above) to produce a bucket 

20 cylinder correction signal. The bucket cylinder 
correction signal would be added to the requested 
bucket velocity signal from the lower portion of the 
control implementation. This function allows the 
operator to correct, modify, or adjust the flow of 

25 hydraulic fluid to the bucket hydraulic cylinder 118 
during bucket attitude control. 

The Cartesian to linkage coordinate 
transformations discussed above use the bucket pin as a 
reference point and do not take into consideration 

3 0 bucket tip position. However, if it is more intuitive 
for the operator to operate the vehicle with the bucket 
tip as the significant end point, translation can be 
easily expanded to accommodate the bucket linkage. 
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In order to perform closed loop control using 
cylinder position feedback, the relative displacement 
(extension and retraction) of each cylinder 
112,114,116,118 must be available. In the preferred 
5 embodiment, sensors (means 603) are used to measure the 
relative angles between the work vehicle 156, the boom 
104, the stick 106 and the bucket 108. 

In an alternate embodiment, the cylinder 
displacement is measured directly. One suitable sensor 
10 is the radio frequency (RF) linear position sensor, as 
disclosed in U.S. Patent No. 4,737,705, issued April 
12, 1988 to Bitar, et al. A potentiometer based sensor 
may also be used. 

Below, in a discussion describing in depth 
15 the derivation of the calculations used in the 

coordinated control implementation, the following 
designations are used: 



L a length of constant magnitude, 

X a length of varying magnitude, 

20 A an angle of constant magnitude, and 

G an angle of varying magnitude. 



Referring back to Fig. 2, each length (L,X) has two 
subscripts, which define the two points between which 
the length is referenced. Each angle (A, 8) has three 

25 subscripts, which define the the lines between which 
the angle is measured (the middle subscript being the 
vertex of the angle) . 

The following equations (1)-(51) show the 
derivation of the calculation used to perform the 

30 various control modes. The equations are dependent 

upon the particular geometry of the work implement, as 
shown in Figs. 1 and 2. However, the present invention 
is not limited to one geometry. Similar derivations 
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10 

15 



20 



25 



are used to adapt the present invention to different 
work implement geometries. 

If joint angle resolvers are used to measure 
linkage positions, the measured relative angles from 
the resolvers must be converted to cylinder 
displacements. Based on the law of cosines, the 
relative cylinder displacement of the boom hydraulic 
cylinders 112,114, * cl is determined by the formula: 



*cl - <t L bl +L bc - 2L bl L bc cos ^abl +A cbe +e abe)>^ < X > 



Likewise, the relative displacement of the 
stick hydraulic cylinder 116 is determined by the 
formula: 

X df -< £ L L +L ef - 2L de L ef cos <*" J W A f ei^bei* ^ ' < 2 > 



Similarly, the relative displacement of the 
bucket hydraulic cylinder 118 is determined by the 
formula: 

30 NrT^gh + 4> - 2 \hhij cos ( 2 ^ A ehg- A ehj- e jhi)3>^ (3) 



35 



40 



In the preferred embodiment, the measured 
angle (Sjj^) is on the linkage 158. To determine the 
angle of the bucket 108, © Q ^ m * relative to the stick 
106 the following set of equations are used: 

6 jhi +G h j i +e k j i +e jki +e hik =2 " ' ( 4 > 
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20 



25 



30 



35 
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e oik =A kim +e oiin' and <5) 



e hik +A eih +e oik =7r ' (6) 



e oim=- 7r+G h j i +9 k j i +G jki- A eih" A ki m +e jhi • (7 > 

15 Where , 



(8) 



e kji- COS_1 [^ij +L jk " L L )/(2L jk X. j) ], (9) 



^ilT^i +L nj " 2L hi hij^^jhiJ^^ and (10) 



e jki =COS ~ 1[(L jk +L ik )/(2L jk L ik>3- < X1 > 



With reference to Fig, 7, the operation of 
the present invention is as follows: first in a control 
block 702 the lever command signals are read from the 
40 control levers. In a control block 704, the desired 
mode is read from the means 144. 

In a control block 706, the desired angular 
velocities of the boom, stick, and bucket linkages are 
determined as a function of the mode and the lever 
45 command signals. 

In a control block 708, the angular 
velocities are translated into linear velocities of the 
linkage cylinders. The linear velocities are then used 
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to controllably actuate the cylinders in control block 
710. 

In the linear control mode or the linear 
control with bucket attitude control mode, velocity 
5 request signals representative of the desired 

horizontal and vertical velocities are received from 
the control levers 130,132. The horizontal velocity 
request and the vertical request are integrated to 
determine the desired position components (x,y) of the 
10 bucket pin, point i. The desired position must be 
translated into desired cylinder velocity commands. 

First, the desired position commands (x,y) 
are related to the boom 104: 

15 ^ be cosG abe+ L ei cos(e abe+ e be .) . (12) 



20 y=L beS ine abe+ L ei sin(e abe+ e bei ) . (13) 



25 ^ bi ={[y 2+ x 2 ]}^. (14) 



30 6 iba =tan" 1 (y/x) . (15) 



35 W 00 *"^ <*bi +L L " L ei > / < 2 *bi L be> 3 ' < 16 > 



40 e abe =9 ebi +e iba- < 17 > 
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e -cos' 1 [(A 2 +L 2 -L 2 )/(2A, L ) J+tan'^y/x) . . a . 
5 abe bi be ei bi be lAO ' 

10 Where, © abe is the desired boom angle. 

6 . is transformed into desired boom 
ace 

cylinder length, X cl , by equation 1. 

Equation 17 is differentiated to determined 
the desired angular velocity of the boom 104: 



15 

20 

25 
30 

35 



e . =e . . +e.. . (19) 

abe ebi iba v ' 



e abe =t ( cose ebi/ X bi sine ebi ) - (1/L be sine ebi> ] *k>i 

+ (l/>. bi 2 ) (xy'-yx') • (20) 



*t>i =(yy /+xx ')/ A -bi- (21) 



e abe ( cose ebi/ X bi>-^/ L be> ^ A bi sin6 ebi> 

45 

-y(iA bi 2 ) }x'+m (cose ebi /X bi ) 

50 2 

-(l/L be )]/X bi sine eb .)+x(l/A. bi ^)}y . (22) 

55 

Where, " '" denotes differentiation. 

60 The desired boom cylinder velocity is 

determined using the equation: 
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L =Cfec hi Sin ^bl + fcbe + abe >/Jl 3§be ' < 23 > 

5 

The desired stick angle is: 

10 e bei =cosrl [ ( L be 2+L ei 2 - A bi 2 > > < 2L be L ei 0 3 "* • < 24 > 

Using equations 2 and 14, desired stick angular 
15 velocity is: 



20 
25 



30 



45 



50 



G bei -t^/ L be L ei sin(e bei +7r ^ x 

+{y/ ( L b e L ei sin(G bei +7r) ]y ' • (25) 

The desired stick cylinder velocity is then determined 
by the equation: 



w df " Li^ de ^ ef ^»i« « de b ~fei v bei"~df Jv bei 

35 The calculations of boom and stick desired 

cylinder velocities in the slope finish control mode 
and the slope finish with bucket attitude control mode 
are similar to those used in the linear control mode 

40 and the linear with bucket attitude control mode, 

except that the desired slope angle, r, is introduced 
into the equations. 

Therefore, the equations for the desired 
position of the bucket pin, point i, become: 



x=L be cos (e abe +r) +L e .cos <e abe +r+e be .) . (27) 



y=L be sin(e abe+ r )+ L ei sin(e abe+ r + e bei ). (28) 
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The desired boom angle becomes: 



5 9 abe =coil ^ X hl +L be +L ei >/< 2 *bi L be>3 
10 +tan -1 (y/x)+r. (29) 



15 Carrying the transformations through, the 

desired angular velocity of the boom and the stick 
104,106 become: 

20 9 abe ={* cos ( r > [ (cose ebi /X bi ) 

25 -(VL be )]/(X bi sine ebi )«y(l/X bi 2 )}x # 

30 +{ysin(D [ (cose ebi /X bi ) 

35 -(VL^Cl/^.sine^.J-xCl/^ 2 )}y\ (30) 

40 e be . =-[xsin(r)/(L bi L e .sin(e bei +7r) ]x' 

45 +[ycos (D / (L bi L ei sin(9 bei +7r) ]y' . (31) 

50 

The desired boom cylinder and stick velocities are 
calculated using equations 23 and 26. 

In the bucket attitude control option, the 
bucket 108 is maintained at a constant angle with 

55 respect to the vehicle. During extension (or 

retraction) of the boom and stick hydraulic cylinders 
112,114,116, the bucket attitude angle is maintained 
through actuation of the bucket hydraulic cylinder 118, 
The stick and boom desired velocity commands are not 

60 modified. 



WO 94/26988 



- 25 - 



PCT/US94/02646 



The bucket attitude angle is related to the 
resolver measured angles by the equations: 

e abe + (^ +e b ei> + ( 7r+e oim ) + (7r ^ )=27r - < 32 > 



10 e oim = *- M abe^ e bei- < 33 > 



is e' . =0 ' -e ' -e' . . (34) 
oim ^ abe bex 1 ' 



20 



35 
40 



Where, 0, represents the bucket attitude angle. 

To determine the desired angular velocity of 
the bucket 108, the angular velocity of the boom 104 
and the stick 106 must be known. 
25 The angular velocity of the boom is 

determined using commanded angular velocity as follows: 



30 X cl = { CL bc 2 +L bl 2 -2L bc L bl cos (A abl+ A cbe+ e abe ) ] >* . (35) 



*cl = [ L bc L bl sin ( A abl +A cbe +e abe)/ X cll e abe • < 36 > 



45 <be =^cl/< L bc L bl sin ( e abe +A abl +A cbe))^cl- < 37 > 
50 

Likewise, the angular velocity of the stick 
106 is determined: 
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A deb +e def +A f ei + < ff+e bei> =27r ' ( 38 > 



10 



45 



50 



55 



e bei =7r - A deb- A fei- 9 def- (39) 



15 e d«£- COB ' 1 C ( L de 2+L ef 2 " X df 2 ) / < 2L de L ef > 3 ' < 40 > 



20 6 bei =-t X df^ L de L ef sin(,r - a deb- A fei- e bei>^df * < 41) 
25 

Therefore, the desired bucket angular 
velocity is determined as: 

30 •'• 9 oim -* 1 ^ W < L bc L sin < e abe +A abl +A cbe> ) 3 *cl 

35 + tX df /(L de L ef sin( W -a deb -A fei -e be .)]X df . (42) 

40 Where, <p' is a requested bucket velocity input from one 
of the control levers 130,132. 

The desired bucket cylinder velocity is 
determined using the desired angular velocity of the 
bucket and the equations: 



e jhi =7r - G hji- e kji- e jki +A eih +A kim +e oim- < 43 > 



*ij =( L hi L hj sin(e jhi>/ X ij )9 jhi ' < 44 > 
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10 
15 



45 



50 



/ / / / / 



e jhi "~ e hji ~ e kji ~ e jki +e oim- (45) 



e hji = < L hi sin9 jhit L hj cos(e hji>/ X ij- 1 -»/ 

<*ij sine hji>> G jhi- < 46 > 



20 6 kji= < L hi L hj sin9 jhi[ L jk cos < e kji>/ X ij- 1 3/ 
25 



(L jk X ij Sine kji°> e jhi- < 47 > 



30 6 jki = t L hi L hj Sin9 jhi^ L jk L ik Sin9 jki^ e jhi- < 48 > 

35 

e'. . =[1/(1+9,1.. +©i i • • +©', )]©' • (49) 

40 ^hi 1 /v h;ji k.jx ]ki 7 J oim 1 ' 



*gj =(- L gh L hj Sin(27r_A ehg- A ehi- e jhi)/ X gj> e jhi ' < 50 > 

In the slope finish with bucket attitude 
control mode, equation 33 is modified to compensate for 
the desired slope angle: 

55 e oim-*-*-< e abe- r >- e bei- < 51 > 

The desire bucket cylinder velocity is determined in 
60 the same manner as described above. 

As discussed above in reference to Fig. 6, 
the output of the coordinated control is a plurality of 
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linear velocity requests. The velocity requests are 
used by the velocity control block 608. The velocity 
control block 608 uses an open or closed feedback 
scheme to control the operation of the hydraulic 
5 cylinders 112,114,116,118. 

Since the lever inputs relate to different 
types of requests depending upon the control mode, the 
lever commands have different units of measure. For 
example, in the manual control mode, the lever command 

10 signals correspond to desired angular velocity of the 
respective linkages. In the automatic modes, at least 
two of the control lever signals correspond to desired 
linear velocity of a point on the linkage along an 
axis. Therefore, the coordinated control determine the 

15 mode being operated in and responsively convert the 

lever command signals which may be in terms of angular 
velocity or linear velocity to linear velocity 
requests • 

20 In the preferred embodiment, the linear 

velocity commands are determined using matrix 
multiplication. The basic matrix equation is: 

[C] = [T] • [Ij] , (52) 

25 

where [C] is the cylinder velocity command matrix, [T] 
is a transformation matrix, and [L] is a lever command 
matrix. 

The cylinder velocity command matrix is a 3x1 
3 0 matrix and is of the form: 
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(53) 



In the preferred embodiment, c 1 corresponds to the 
15 desired boom cylinder velocity signal and is 

proportional to the desired boom cylinder velocity , 
c 2 , is corresponds to the desired stick cylinder 
velocity signal and is proportional to the desired 
stick cylinder velocity, and c 3 is the desired bucket 
20 cylinder velocity signal and is proportional to the 
desired bucket cylinder velocity. 

The lever command matrix is a 3x1 matrix and 
is of the form: 



25 
30 
35 
40 



[L] = 



(54) 



The significance of 1 1# 1 2 , and ± 2 varies 
depending upon the control mode. 



In the manual mode, 1 1 corresponds to the 
desired boom cylinder linear velocity, 1 2 corresponds 
45 to the desired stick cylinder linear velocity, and 1 3 
corresponds to the desired bucket cylinder linear 
velocity. 

In the manual mode with bucket attitude 
control, 1 1 corresponds to the desired boom cylinder 
50 linear velocity, 1 2 corresponds to the desired stick 
cylinder linear velocity, and 1 3 corresponds to a 
desired bucket cylinder adjustment. 
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In the linear control mode, 1 1 corresponds to 
the desired velocity along the horizontal axis (X), 1 2 
corresponds to the desired velocity along the vertical 
axis, and 1 3 corresponds to the desired bucket angular 
5 velocity. 

In the linear control mode with bucket 
attitude control, 1 1 corresponds to the desired 
velocity along the horizontal axis, 1 2 corresponds to 
the desired velocity along the horizontal axis, and 1^ 

10 corresponds to the desired bucket adjustment. 

In the slope finish control mode, 1^ 
corresponds to the desired velocity along the X' axis, 
1- corresponds to the desired velocity along the Y' 
axis, and 1 3 corresponds to the desired bucket angular 

15 velocity, where X' and Y' are defined by the offset 
angle. 

In the slope finish control mode with bucket 
attitude control, 1^ = the desired velocity along the 
X' axis, 1 2 = the desired velocity along the Y' axis, 
20 and 1 3 = the desired bucket adjustment, where X' and Y' 
are defined by the offset angle. 

The transformation matrix is a 3x3 matrix and 
is of the form: 



25 
30 
35 
40 
45 
50 



[T] - 





_t ll fc 12 


*13 








fc 31 *32 


*23 
*33 . 








S l' r ll 


S l* r 12 


S l #r l3 






S 2 #r 21 


S 2 #r 22 


S 2 #r 23 


(55) 




S 3 #r 31 


S 3 #r 32 


S 3 #r 33 
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As shown, each element of [T] consists of the product 

between an r term and a s_ term. The r „ terms are 
pq o pq 

dependent upon the operating mode (see below) and 
effectually convert the lever command signals into 
terms of desired angular velocities (based on the 
current control mode) . The s q terms effectually 
convert from angular velocity to linear velocity. 

Substituting equations (53) -(55) into 
equation (52), leaves: 

C l " S l # < r il #1 l + r i2 #1 2 + r i3 #1 3>- < 56 > 
C 2 " S 2 #(r 21 #1 l + r !2 #1 2 + r 23 #1 3>- < 57 > 

15 c 3 = s 3 #(r 31 #1 l + r 32 #1 2 + r 33 #1 3 } - (58) 

As stated above, each of the terms in 
equations varies, dependent upon the mode. The 
equation for each term in each is based on the 
20 derivations above and will now be discussed. 

In the manual mode, the lever command signals 
are indicative of the desired hydraulic flow to each of 
the cylinders 112,114,116,118. Therefore the lever 
command signals are passed to the velocity control 
25 block 608. The terms have the following values: 

1 and 



0. 

ji J<S 

3 0 Therefore, 



r ll 




r 22 




r 33 


r i2 




r l3 




r 23 


r 31 




r 21 




r 32 


C l 










C 2 




X 2' 


and 




C 3 
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In the manual mode with bucket attitude 
control, the boom and stick cylinders are treated the 
same as in the manual mode. Only the terms relating to 
the bucket cylinder are changed. 



r ll r 22 = 1 and 

r l2 = r 13 = r 23 = r 21 " °» 



10 r 31 = A, 



15 



r 32 = A • B, and 



r 33 = A • C, where 



A = , (59) 

20 1 + e hji + e kji + e jki 

B = , and 

L bc #L ef #sin(A abe ~ A abl " A cbe> 
25 (60) 

- ^df 

c = . 



L de #L ef #sin(7r " A deb ~ A fei " G bei> 



30 (61) 

The r terms must now be converted from 
pq 

terms of angular velocity to terms of linear velocity. 
This is done by multiplying r 31 , r 32 , and r 33 by c^ f 



35 where 
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- L gh #L hj* Sin(27r " A ehg - A ehi " e jhi> 



s 3 = 



(62) 

5 

In the linear control mode, the first, second 
and third lever command signals are indicative of 
desired movement along an X axis 404, a Y axis 412 and 
desired hydraulic flow to the bucket cylinder. The 
10 terms of equations (56) -(58) are determined by: 



r ll = D, 
r 12 = E ' 



r 

13 



0, 



15 r 21 = F, 

r 22 = G ' 

r 23 - °» 

r 31 = °' 

r 32 = °' and 

20 r 33 = l. 



D = x.[(co S( e ebi )/A. bi )-(i/L be ) ] 

25 X b . • sin 6 ebi 

y/Xbi 2; (63) 
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10 



y. [ (cos(6 ebi ) M bi )-(1/L be ) ] 



*bi * Sin e ebi 



x/X bi 2 ; (64) 



F = ; (65) 

L be ,L ei' sin < 0 bei +7r > 



L be -L ei #sin < 9 bei +7r > 



■; and (66) 



15 s i - L bc ,L bl' sin < A abl +A cbe +0 abe> 

/^ cl ; (67) 



20 L de . L ef • sin (^~A deb+ A f e . +e be .) 

s. 



'2 



(68) 



25 The term s 3 is used as defined in Equation (62) . 

In the linear control mode with bucket 
attitude control mode, the first and second lever 
command signals are indicative desired movement along 
the X and Y axis 404,412- The bucket is adjusted to 

30 maintain a constant bucket angle. Adjustment of the 

bucket angle may be provided through the third control 
lever command signal. The terms of equations (56) -(58) 
are determined by: 
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r il 




D, 


r l2 


= 


E, 


r l3 


= 


o, 


r 21 




F, 


r 22 




G, 


r 23 




0, 


r 31 




A, 


r 32 




A • B, 


r 33 




A • C, 



C, where A,B,C,D,E,F,G,S 1 , S 2 , and 
10 S 3 are determined using equations 

(59), (60), (61), (63), (64), (65), (66), (67), (68) f and (62), 
respectively . 

In the slope control mode, the terms are 
similar to those used in the linear control mode, but 
15 are adjusted to account for the desired slope angle r. 
The terms are therefore determined by: 



r ll - H, 

r 12 = 

20 r 13 = 0, 

r 21 = J, 

r 22 = K ' 

r 23 = °» 

r 31 = °' 

25 r 32 = 0, and 



r 33 = X » 



where 

30 



H = x« cos (r) • [ (cos (0 ebi ) / X hi ) - ( 1/L be ) ] 



*bi ' sin 9 ebi 
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y/Xbi2. 



ysin(r).[(cos(e ebi )/X b .)-(i/L be )] 



*bi * sin G ebi 



10 x • sin(r) 

j = ; and 

h>e #L ei #sin < 9 bei +7r > 



15 y • sin(r) 

K = 



L be #L ei #sin < 0 bei +7r > 



20 and where s 1# s 2 , and s 3 are determined by Equations 
(67), (68), and (62), respectfully. 

In the slope control mode with bucket 
attitude control mode, the terms are similar to those 
used in the slope control mode, but the bucket angle is 
25 maintained at a constant angle. The terms are 
therefore determined by: 
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5 



r ll 


= 


H, 


r l2 


— 


I, 


r l3 


= 


0, 


r 21 




J, 


r 22 




K, 


r 23 




0, 


r 31 




A, 


r 32 




A 


r 33 




A 



• B, and 

• C. 



Industrial Applicability 

With reference to the drawings, and in 
operation, the present invention is adapted to provide 
a coordinated control for a work vehicle's work 

15 implement. In the excavator, as discussed above, a 

manual control mode is provided. An operator using the 
control levers 130,132 operates the work implement 102 
to perform the digging operations typical in the 
vehicle's work cycle, in a normal manner. 

20 However, in order to automatically "finish" 

or provide a smooth surface using the bucket 108, one 
of the additional modes of the control system 100 is 
used. For example, to provide a level floor, the 
operator manually positions the bucket 108 at a point 

25 on the desired path. The control system 100 is 

transferred to the linear control mode. In the linear 
control mode, linear horizontal movement of the bucket 
pin (point i) is controlled by movement of the first 
control lever 13 0 along the first control axis 13 6. 

30 Therefore, the operator need only pull back on the 
first control lever 13 0 and the control system 100 
coordinates flow of hydraulic fluid to the cylinders 
112,114,116 to provide the linear movement. Linear 
vertical movement is provided by movement of the first 
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joystick along a second control axis 138. 
Alternatively, vertical movement may be controlled by a 
second control lever 132. 

In the slope finish control modes, the 
5 operator must also signal the control system 100 as to 
the desired slope angle. In the preferred embodiment, 
the operator simply dials in the desired slope angle on 
the thumb wheel switch 146. 

In an alternate embodiment, the operator 
10 first positions the bucket 108 at a first point on the 
desired slope and signals the control system 100. Then 
the operator positions the bucket 108 at a second point 
on the desired slope and signals the control system 
(100) . The control system then calculates the desired 
15 slope based on the bucket positions. 

In the bucket attitude control modes (linear 
and slope) , the operator positions the bucket at the 
desired bucket attitude angle prior to engaging the 
linear or slope control mode. 



20 
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Claims 

1. An apparatus (100) for controllably 
moving a vehicle's work implement (102) having a first 
5 appendage (104) pivotally connected to the vehicle, and 
a second appendage (106) having first and second end 
points and being pivotally connected to the first 
appendage (104) at the first end point, comprising: 

means (603) for sensing the geometry of the 
10 work implement (102) and responsibly producing a 
plurality of position signals; 

means (144) for producing one of a manual 
control mode signal and an automatic control mode 
signal; 

15 operator interface means (128) for producing 

first and second lever command signals indicative of 
desired movement of the work implement (102); 

logic means (154) for receiving said one 
control mode signal and said first and second lever 
20 control signals, responsively producing linear motion 
of the second end point of the second appendage (106) 
along first and second work axes in response said one 
control mode signal being equal to said automatic 
control mode signal, and responsively producing angular 
25 motion of said first and second appendages (104,106) in 
proportion to said first and second lever command 
signals, respectively, in response to said one control 
signal being equal to said manual control mode signal, 
said logic means including: 
3 0 means for receiving said position signals; 

responsibly calculating a plurality of mode value 
signals ( r p g) > wherein said mode value signals are 
in terms of angular velocities of the work 
implement (102) in response to said one control 
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mode signal being equal to the automatic control 
mode signal; 

means for responsibly calculating a plurality 
angular-to-linear value signal (c q ) , wherein said 
5 angular-to-linear value signals are in terms of 

linear velocity over angular velocity in response 
to said one control mode signal being equal to the 
automatic control mode signal; and 

means for calculating a plurality of 
10 transformation signals as a function of said 

angular-to-linear value and mode value signals; 
and for calculating a plurality of cylinder 
velocity command signals as a function of said 
mode value signals and said angular-to-linear 
15 value signals; and, 

actuating means (109) for receiving said 
cylinder velocity command signals and responsibly 
actuating the work implement (102) . 

20 2. An apparatus (100) , as set forth in 

claim 1, wherein said first and second lever command 
signals being indicative of desired movement along an X 
axis and a Y axis respectively, in response to said one 
control mode being equal to said automatic control mode 

25 signal, wherein said X and Y axes are perpendicular. 

3. An apparatus, as set forth in claim 1, 
including a third appendage pivotal ly connected to the 
second end point of the second appendage, said third 
30 appendage having an angular relationship with a 
horizontal plane, and wherein: 

said operator interface means (128) include 
means for producing a third lever command signal and 
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said control mode signal producing means 
(144) includes means for producing an automatic with 
bucket attitude control mode signal. 



5 4. An apparatus (100), as set forth in 

claim 3, including means (144) for producing a slope 
angle signal (T) indicative of a desired slope angle 
and wherein: 

said third lever command signal being 

10 indicative of a desired angular velocity of said third 
appendage in response to said one control mode signal 
being equal to the manual control mode signal; and 

said first and second lever command signals 
being indicative of desired movement along an X axis 

15 and a Y axis, respectively, and said third lever 

command signal being indicative of a desired angular 
velocity of said third appendage (108) in response to 
said one control mode signal being equal to said 
automatic control mode signal, said X and Y axes being 

20 perpendicular. 

5. An apparatus (100), as set forth in 
claim 3, including means (144) for producing a slope 
angle signal (T) indicative of a desired slope angle 

25 and wherein: 

said control mode signal producing means 
(144) includes means for producing a slope finish 
control mode signal and a slope finish with bucket 
attitude control mode signal; 

30 said first and second lever command signals 

being indicative of desired movement along an X axis 
and a Y axis, respectively, in response to said one 
control mode signal being equal to said automatic 
control with bucket attitude mode signal, said X and Y 
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axes being perpendicular and said logic means (154) 
being adapted to maintain the said angular 
relationship; 

said first and second lever command signals 
5 being indicative of desired movement along an X' axis 
and a Y' axis, respectively, and said third lever 
command signal being indicative of a desired angular 
velocity of said third appendage in response to said 
one control mode signal being equal to said slope 

10 control mode signal, said X' and Y' axes being 
perpendicular, said X' axis having a angular 
relationship with said horizontal plane proportional to 
said slope angle signal (r) ; and 

said first and second lever command signals 

15 being indicative of desired movement along an X' axis 
and a Y' axis, respectively, in response to said one 
control mode signal being equal to said slop control 
with bucket attitude control mode signal, said X' and 
Y' axes being perpendicular, said X' axis having an 

20 angular relationship with said horizontal plane 

proportional to said slope angle signal (T) and said 
logic means (154) being adapted to maintain said 
angular relationship. 

25 6, An apparatus (100) , as set forth in 

claim 3, including means (144) for producing a slope 
angle signal (T) indicative of a desired slope angle 
and wherein: 

said control mode signal producing means 

3 0 (144) includes means for producing a slope finish 
control mode signal and a slope finish with bucket 
attitude control mode signal; 

said first, second, and third lever command 
signals being indicative of desired angular velocities 
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of the first, second and, third appendages, 
respectively, in response to said one control mode 
signal being equal to the manual control mode signal; 

said first and second lever command signals 
5 being indicative of desired movement along an X axis 
and a Y axis, respectively, and said third lever 
command signal being indicative of a desired angular 
velocity of said third appendage in response to said 
one control mode signal being equal to said automatic 

10 control mode signal, said X and Y axes being 
perpendicular ; 

said first and second lever command signals 
being indicative of desired movement along an X axis 
and a Y axis, respectively, in response to said one 

15 control mode signal being equal to said automatic 

control with bucket attitude mode signal, said X and Y 
axes being perpendicular and said logic means (154) 
being adapted to maintain the said angular 
relationship ; 

20 said first and second lever command signals 

being indicative of desired movement along an X' axis 
and a Y' axis, respectively, and said third lever 
command signal being indicative of a desired angular 
velocity of said third appendage in response to said 

25 one control mode signal being equal to said slope 
control mode signal, said X' and Y' axes being 
perpendicular, said X' axis having a angular 
relationship with said horizontal plane proportional to 
said slope angle signal (T) ; and 

3 0 said first and second lever command signals 

being indicative of desired movement along an X' axis 
and a Y' axis, respectively, in response to said one 
control mode signal being equal to said slop control 
with bucket attitude control mode signal, said X' and 
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Y' axes being perpendicular, said X' axis having an 
angular relationship with said horizontal plane 
proportional to said slope angle signal (r) and said 
logic means (154) being adapted to maintain said 
5 angular relationship. 



7. A method for controllably moving a 
vehicle's work implement (102) having a first appendage 
(104) pivotally connected to the vehicle, and a second 
10 appendage (106) having first and second end points and 
being pivotally connected to the first appendage (104) 
at the first end point, including: 

sensing the geometry of said work implement 
(102) and responsively producing a plurality of 
15 position signals; 

sensing movement of a plurality of control 
levers and responsively producing a plurality of lever 
command signals; 

producing a control signal in response to 
20 receiving one of a manual control mode signal and an 
automatic control mode signal; 

receiving said one control mode signal and 
said first and second lever control signals; 

responsively producing linear motion of the 
25 second end point of the second appendage (106) along 
first and second work axes in response said control 
signal being equal to said automatic control mode 
signal; 

responsively producing angular motion of said 
30 first and second appendages (104,106) in proportion to 
said first and second lever command signals, 
respectively, in response to said control signal being 
equal to said manual control mode signal; wherein said 
motion producing steps include the steps of: 



WO 94/26988 



PCT/US94/02646 



- 45 - 



calculating a mode value signal (r ) 
corresponding to each transformation signal as a 
function of said mode signal, said plurality of 
lever command signals, and said position signals, 
5 wherein said mode value signals are in terms of 

angular velocities of the work implement in 
response to the mode signal being equal to the the 
automatic control mode signal, 

calculating an angular-to-linear value 

10 signal (c Q ) corresponding to each transformation 

signal as a function of said mode signal, said 
plurality of lever command signals, and said 
position signals, wherein said angular-to-linear 
value signals are in terms of linear velocity over 

15 angular velocity in response to the mode signal 

being equal to the automatic control mode signal, 
and 

calculating a plurality of 

transformation signals (t,) as a function of said 

mn 

20 angular-to-linear value and mode value signals. 
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